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Abstract:  It  has  been  known  for  some  time  that  the  classical  work  of  Kirchhoff,  Love, 
and  Birkhoff  on  rigid  bodies  in  incompressible,  irrotational  flows  provides  effective  models 
for  treating  control  problems  for  underwater  vehicles.  This  has  also  lead  to  a  better 
appreciation  of  the  dynamics  of  such  systems.  In  this  paper,  we  develop  results  based  on 
geometric  mechanics  and  center  manifold  theory  to  solve  controllability  and  stabilization 
questions  for  a  class  of  under-actuated  left  invariant  mechanical  systems  on  Lie  groups 
that  include  approximate  models  of  underwater  vehicles  and  surface  vehicles.  We  also 
provide  numerical  evidence  to  capture  the  global  properties  of  certain  interesting  feedback 
laws. 

Keywords:  Symmetry,  Lie-Poisson  Reduction,  Underactuated  Systems,  Controlla¬ 
bility,  Stabilization,  Hovercraft,  Underwater  Vehicles 


1  INTRODUCTION 

In  this  paper  we  present  results  related  to  the  con¬ 
trollability  and  stabilization  of  a  class  of  under¬ 
actuated  mechanical  systems  with  symmetry.  We 
consider  systems  with  configuration  space  G,  a  Lie 
group,  and  G-invariant  forced  dynamics  on  the 
cotangent  bundle  T*G. 

This  research  is  motivated  by  issues  related  to  the 
control  of  under- actuated  hovercraft  and  underwa¬ 
ter  vehicles.  It  can  be  shown  that  simplified  mod¬ 
els  of  these  systems  satisfy  the  above  assumption 
of  G-invariance  (see  Section  2).  For  example,  if 
an  underwater  vehicle  is  modeled  as  a  completely 
submerged  rigid  body  in  an  inviscid,  incompress¬ 
ible  and  irrotational  fluid  of  infinite  volume,  the 
impulse  motion  of  the  body-fluid  system  can  be 
shown  (Lamb,  1945;  Birkhoff,  1960)  to  vary  as 
the  momentum  of  a  finite  dimensional  system  un¬ 
der  the  influence  of  external  forces.  Hence,  iden¬ 
tifying  the  configuration  space  of  the  underwater 
vehicle  with  the  Lie  group  SE( 3),  the  dynamics 
can  be  modeled  on  T*SE( 3).  The  existence  of  a 

*This  research  was  supported  in  part  by  a  grant  from 
the  National  Science  Foundation’s  Engineering  Research 
Centers  Program:  NSFD  CDR  8803012,  and  by  the  Army 
Research  Office  under  the  MURI97  Program  Grant  No. 
DAAG55-97-1-0114  to  the  Center  for  Dynamics  and  Con¬ 
trol  of  Smart  Structures. 


control  law  to  steer  these  systems  in  situations  of 
actuator  failure  poses  an  interesting  problem.  To 
resolve  questions  related  to  controllability  we  ob¬ 
serve  that  a  geometric  approach  leads  to  a  deeper 
understanding  of  the  problem.  The  G-invariance 
permits  the  dropping  of  the  dynamics  to  a  lower 
dimensional  space,  namely  the  quotient  manifold, 
T*G/G.  Analysis  of  the  reduced  dynamics  pro¬ 
vides  insight  into  properties  of  the  unreduced  dy¬ 
namics.  In  (Manikonda  and  Krishnaprasad,  1997) 
we  presented  sufficient  conditions  (Theorem  3.2) 
for  controllability  of  the  reduced  dynamics  of  these 
systems.  In  this  paper  we  extend  these  results  and 
present  sufficient  conditions  for  controllability  of 
the  unreduced  dynamics  (Theorem  3.6  and  Theo¬ 
rem  3.10). 

In  addition  to  proving  results  on  controllability, 
in  this  paper,  we  also  present  a  general  ap¬ 
proach  (Theorem  4.2),  based  on  center  manifold 
theory,  to  construct  feedback  laws  to  stabilize  rel¬ 
ative  equilibria  of  mechanical  systems  with  sym¬ 
metry.  Our  approach  again  exploits  the  geometry 
of  the  reduced  space  and  the  Lie-Poisson  structure 
to  show  that  under  certain  hypothesis  the  fixed 
points  of  the  reduced  dynamics  can  be  shown  to 
belong  to  an  immersed  equilibrium  manifold  (The¬ 
orem  4.1).  The  existence  of  this  equilibrium  man¬ 
ifold  and  controllability  are  used  to  design  stabi- 


lizing  feedback  laws. 

The  paper  is  organized  as  follows.  In  Section  2 
following  a  brief  discussion  on  Lie-Poisson  re¬ 
duction,  examples  of  left-invariant  mechanical 
systems  are  presented.  In  Section  3  we  present 
results  on  controllability.  In  Section  4  a  general 
approach  based  on  center  manifold  theory,  to 
construct  feedback  laws  to  stabilize  relative 
equilibria  are  presented.  Conclusions  and  direc¬ 
tions  for  future  research  are  discussed  in  Section  5. 


2  PRELIMINARIES  AND 
EXAMPLES 

In  this  section  we  present,  briefly,  the  geometric 
framework  used  in  this  paper.  For  the  class  of 
mechanical  systems  discussed,  we  assume  that  the 
configuration  space  of  these  systems  can  be  identi¬ 
fied  with  a  Lie  group  G  .  We  model  the  dynamics 
of  these  systems  as  controlled  Hamiltonian  sys¬ 
tems  on  T*G.  Written  in  the  form  of  an  affine 
nonlinear  control  system  the  dynamics  take  the 
form 

m 

E:  x  =  XH(x)  +  J^Yi(x)ui.  (1) 

In  Equation  (1)  Xh  is  a  Hamiltonian  vector  field 
with  respect  to  a  Hamiltonian  H  :  T*G  — >■  1R 
and  the  canonical  Poisson  bracket  on  T*G.  We 
further  assume  that  the  Hamiltonian  H  and  the 
control  vector  fields  Yj  are  G-invariant  i.e.  Mg  £ 
G,  and  x  £  T*G ,  Ho  T*Lg{x)  =  H(x)  and 
T(T* Lg)Yi(x)  =  Yi(T*Lgx ).  Here  Lg  denotes  the 
left  action  of  G  on  itself  and  T*Lg  the  cotangent 
lift  of  Lg. 

Since  T*Lg  is  a  free  and  proper  action  recall  that 
the  dynamics  on  T*G  project  1  to  dynamics  on 
T*G/G  =  0*.  In  particular  the  Hamiltonian  H , 
projects  to  H  defined  on  0*  s.t.  H  =  H  on, 
where  7r  :  T*G  — >•  0*  denotes  the  projection  map, 
and  the  Hamiltonian  vector  field  Xh  projects  to  a 
Hamiltonian  vector  field  X ^  on  0*.  Further  Xjj  is 
Hamiltonian  on  @1  w.r.t.  to  the  reduced  Hamilto¬ 
nian  H  and  the  minus  Lie-Poisson  bracket  define 
on  0*.  Hence  on  g7  the  reduced  dynamics  are 
given  by 

m 

E:  \x  =  Xjj(n)+'Y^Yi(n)ui  (2) 

i- 1 

As  we  shall  see  the  Lie-Poisson  structure  of  X^ 
and  the  geometry  of  0*  play  an  important  role  in 
determining  controllability  and  stability  proper¬ 
ties  of  the  reduced  system. 

Example  1:  The  Jet-Puck  -  An  Under¬ 
actuated  Hovercraft  We  model  a  hovercraft 
as  a  planar  rigid  body  with  a  vectored  thrust 
(Manikonda  and  Krishnaprasad,  1996)  and  iden¬ 
tify  its  configuration  space  with  SE{ 2)2.  It  is  fur¬ 

1  Duo  to  limitations  on  space  we  do  not  discuss  the 
reduction  process  in  detail.  The  reader  is  referred  to 
(Marsden  and  Ratiu,  1994)  and  references  therein  for 
details. 

2  In  the  rest  of  the  discussion  an  element  of  SE(n ),  n  = 


ther  assumed  that  the  line  of  action  of  the  force 
is  fixed  and  does  not  pass  through  the  center  of 
mass.  Observing  that  the  Lagrangian,  which  is 
simply  the  kinetic  energy,  and  body  fixed  forces, 
are  invariant  under  the  lifted  action  of  SE( 2)  on 
TSE( 2),  the  dynamics  on  T*SE( 2)  project  to  re¬ 
duced  dynamics  on  se(2)*.  Choosing  convected 
linear  momentum,  (Pi,P2)  and  body  angular  mo¬ 
mentum  n  as  coordinates  for  se(2)*,  the  reduced 
dynamics  are  given  by 

Pi  =  P2U/I  +  au 
P2  =  —PiH/I  +  (3u  (3) 

n  =  d/3u 

where  a  =  cos</>,  (3  =  siiuf>.  The  drift  vector  field 
in  (3)  is  a  Lie-Poisson  vector  field  with  respect  to 
the  minus  Lie-Poisson  structure  on  se(2)*  and  the 
reduced  Hamiltonian 


\\P\\ 

2m 


(4) 


Example  2:  Autonomous  Underwater  Ve¬ 
hicle  An  autonomous  underwater  vehicle  can  be 
modeled  as  a  rigid  body  submerged  in  an  infinitely 
large  volume  of  incompressible,  inviscid  and  ir- 
rotational  fluid  which  is  at  rest  at  infinity  (cf. 
(Lamb,  1945;  Birkhoff,  1960;  Leonard,  1997)).  We 
consider  an  underwater  vehicle  with  ellipsoidal  ge¬ 
ometry  and  assume  that  the  center  of  mass  and 
center  of  buoyancy  are  coincident.  Identifying  the 
configuration  space  with  SE( 3),  one  observes  that 
the  Lagrangian  L  :  TSE( 3)  — >  1R  given  by 

L{R,  r,  R,  r)  =  JH  +  vT Mv) 

is  SE(3)-invariant  and  dynamics  on  T*SE( 3) 
project  to  dynamics  on  se(3)*.  Here  f I  and  v 
denote  the  body  angular  velocity,  and  the  lin¬ 
ear  velocity  components  along  the  body  frame. 
J  is  the  body  inertia  matrix  plus  the  added  in¬ 
ertia  matrix  due  to  the  flow  of  the  fluid.  Simi¬ 
larly  M  is  the  mass  matrix  plus  the  added  mass 
matrix  associated  with  the  fluid.  (See  (Lamb, 
1945;  Birkhoff,  1960)  for  details  on  modeling  rigid 
bodies  in  incompressible,  inviscid  and  irrotational 
flows).  Let  us  assume  that  we  have  only  one  pure 
force  and  two  torques  to  control  the  position  and 
orientation  of  the  underwater  vehicle.  Choosing 
n  =  and  P  =  =  Mv  as  coordinates 

for  se(3)*  the  dynamics  on  T*SE( 3),  in  terms  of 
coordinates  (r,  R,  n,  P),  are  given  by 


r 

=  RM_1P 

(5) 

R 

it 

ft) 

II 

(6) 

II 

=  nxj_1n  +  PxM_1p  +  [/i 

(7) 

P 

=  p  x  j-1  n  +  u2 

(8) 

where  U\  =  (ui,u2,0)T  and  U2  =  (u3,0,0)T. 
Equations  (7-8)  correspond  to  the  reduced  dynam¬ 
ics  on  se(3)*. 

Remark:  In  the  rest  of  the  discussion  we  will 
assume  that 

J  =  diag(Ii,  I2, 13)  and  M  =  diag{mi,m2,m^). 

2,  3  is  given  by  the  pair  (R,  r)  where  R  £  SO(n)  and  r  £  ]Rn 
is  a  vector  from  the  origin  of  the  inertial  frame  to  the  origin 
of  the  body  frame. 


3  CONTROLLABILITY 

Proving  controllability  of  affine  nonlinear  control 
systems,  where  the  linearization  is  not  control¬ 
lable,  is  in  general  a  difficult  task.  Important 
contributions  in  this  area  have  been  due  to  Bon¬ 
nard,  Lobry,  Crouch,  Byrnes  and  others  (Jurdjevic 
and  Kupka,  1981;  Crouch  and  Byrnes,  1986;  Lo¬ 
bry,  1974) 

Of  particular  interest  in  the  current  setting  is 
following  result  due  to  (Lobry,  1974;  Lian  et 
al.,  1994)  where  weak  positive  Poisson  stability 
(WPPS)  of  the  drift  vector  field  is  used  to  con¬ 
clude  controllability.  Recall  that  a  vector  field  X 
on  a  manifold  M  is  called  weakly  positively  Pois¬ 
son  stable  if  the  set  of  points  p  €  M  such  that 
for  all  T  >  0  and  any  neighborhood  Vv  of  p,  there 
exists  a  time  t  >  T  such  that  </>* (Vp )C\VP  ^  $ 
(where  <$(VP)  =  {(/>?{q)  \  q  €  Vp })  is  dense  in 
M. 

Theorem  3.1  If  the  system 

m 

X  =  f(x)+^2gi(x)Ui,  u  =  (ui,  •  ■■um)  €  U  C 

i—1 

where  U  contains  { u  \  \ui\  <  Mi  0,  i,  ■  ■  ■ ,  m}  is 
such  that  f  is  a  weakly  positively  Poisson  stable 
vector  field,  then  the  system  is  controllable  if  the 
accessibility  Lie  algebra  rank  condition  (LARC)  is 
satisfied. 

While  proving  WPPS  of  the  drift  vector  field  can 
be  difficult,  in  a  setting  where  the  drift  vector  field 
is  a  Lie-Poisson  reduced  Hamiltonian  vector  field, 
in  (Manikonda  and  Krishnaprasad,  1997)  we  prove 
the  following  result. 

Theorem  3.2  Let  G  be  a  Lie  group  that  acts  on 
itself  by  left  (right)  translations.  Let  H  :  T*G  — > 
R  be  a  left  (right) -invariant  Hamiltonian.  Then, 

(i)  If  G  is  a  compact  group,  the  coadjoint  orbits 
of  g*  =  T*G/G  are  bounded  and  the  Lie-Poisson 
reduced  Hamiltonian  vector  field  Xg  is  WPPS. 

(ii)  If  G  is  a  noncompact  group  then  the  Lie- 
Poisson  reduced  Hamiltonian  vector  field  Xjj  is 
WPPS  if  there  exists  a  function  V  :  g*  —7  1R 
such  that  V(p)  is  bounded  below,  V(ffi)  — 7  oo  as 
||/x||  — 7  oo  and  V  =  0  along  trajectories  of  the 
system. 

Here  H  is  the  induced  Hamiltonian  on  the  quo¬ 
tient  manifold  g*  =  T*G/G  and  {•,•}_(+)  is  the 
induced  minus  (plus)  Lie-Poisson  bracket  on  the 
quotient  manifold  g*  =T*G/G. 

In  our  present  setting  of  Lie-Poisson  reduced  dy¬ 
namics,  WPPS  conditions  in  Theorem  3.1  can  be 
verified  whenever  the  hypotheses  of  Theorem  3.2 
hold.  Once  WPPS  of  the  drift  vector  field  has 
been  established  Theorem  3.1  can  be  used  to  con¬ 
clude  controllability.  In  (Manikonda  and  Krish¬ 
naprasad,  1997)  we  prove  the  following: 

Proposition  3.3  The  reduced  jet-puck  dynamics 
defined  by  (3)  are  controllable  if  sine/)  ^  0. 


Proposition  3.4  The  Lie-Poisson  reduced  dy¬ 
namics  of  the  underwater  vehicle  with  coincident 
center  of  buoyancy  and  center  of  gravity,  defined 
by  (7-8),  are  controllable  if  I\  7^/2. 

If  the  symmetry  group  G  is  compact  we  now  show 
(Theorem  3.6)  that  the  above  hypotheses  are  suf¬ 
ficient  to  conclude  that  the  unreduced  drift  vector 
field  Xu  too  is  WPPS.  To  prove  this  we  need  the 
following  lemma-  (see  (Manikonda,  1997)  for  the 
proof  of  the  lemma  and  Theorem  3.6). 

Lemma  3.5  Let  G  be  a  compact  Lie  group  whose 
action  4>  :  G  x  M  — 7  M  on  a  manifold  M  is  free. 
Let  n  :  M  —7  M/G  denote  the  projection  map. 
Then  D  =  n~1(D)  is  compact  iff  D  C  M/G  is 
compact  i.e  the  projection  map  n  is  a  proper  map. 

Theorem  3.6  Let  G  be  a  compact  Lie  group 
whose  action  on  a  Poisson  manifold  M  is  free  and 
proper.  A  G-invariant  Hamiltonian  vector  field 
Xh  defined  on  a  manifold  M  is  WPPS  if  there 
exists  a  function  V  :  AI/G  — y  R  that  is  proper, 
bounded  below  and  V  =  0  along  trajectories  of  the 
projected  vector  field  Xg  defined  on  AI/G. 

As  mentioned  earlier,  having  concluded  the  WPPS 
nature  of  the  Hamiltonian  vector  field,  if  the 
Hamiltonian  control  system  on  AI  satisfies  the 
LARC,  then  from  Theorem  3.1  controllability  can 
be  concluded.  The  conclusion  on  the  controllabil¬ 
ity  of  the  unreduced  dynamics  where  G  is  com¬ 
pact  is  similar  in  spirit  to  that  of  (Martin  and 
Crouch,  1984). 

In  the  present  setting  of  hovercraft  and  underwa¬ 
ter  vehicles  we  observe  that  though  SE(n),  n  = 
2, 3  is  not  a  compact  group,  it  is  a  semidirect  prod¬ 
uct,  i.e.  G  =  H  xpV  where  H  =  SO(n )  is  com¬ 
pact  and  V  =  IR"  is  a  vector  space.  For  semidirect 
products  one  observes  that  G/V  =  H.  Hence  re¬ 
duction  of  G-invariant  dynamics  can  be  performed 
in  two  stages.  First  by  V,  to  obtain  dynamics  on 
H  x  g*,  and  then  by  H  to  obtain  the  reduced  dy¬ 
namics  on  g*.  Hence  under  appropriate  LARC 
assumptions  we  can  conclude  the  reduced  dynam¬ 
ics  on  H  x  g*  are  controllable  iff  the  Lie-Poisson 
reduced  dynamics  on  T*G/G  are  controllable. 

Applying  these  results  to  the  examples  discussed 
earlier  we  have  the  following  results. 

Proposition  3.7  The  reduced  dynamics  of  the 
jet-puck  defined  on  SO( 2)  xse(2)*  are  controllable 
if  sin0  0. 

Proposition  3.8  The  reduced  dynamics  (6-8)  of 
the  underwater  vehicle  with  coincident  center  of 
mass  and  center  of  buoyancy,  defined  on  SO{ 3)  x 
se(3)*  are  controllable  if  I\  7^  -Z2. 

In  the  setting  where  the  symmetry  group  is  non¬ 
compact,  under  additional  assumptions  of  equi¬ 
librium  controllability,  reduced  space  controllabil¬ 
ity  is  sufficient  to  conclude  controllability  on  T*G. 


Before  we  prove  this  result  we  define  equilibrium 
controllability,  a  concept  introduced  in  (Lewis  and 
Murray,  1996).  Consider  a  mechanical  system 
with  a  G-invariant  Hamiltonian  and  G-invariant 
forces.  Assume  that  the  Hamiltonian  is  quadratic 
and  projects  to  H  =  /iTI~V,  74  G  g*,  where 
I  :  g  — >■  g*  is  the  inertia  tensor.  Then  the  dynam¬ 
ics  on  T*G  can  be  written  in  the  form 

9  =  (9) 

m 

A  =  A  (n)S7H  +  ^2fui.  (10) 

i—1 

Here  A  (74)  is  the  Lie-Poisson  tensor  defined  on  g*. 

Definition  3.9  The  system  (9-10)  is  equilibrium 
controllable  if  for  any  (51,  0),  (<72, 0)  there  exists  a 
time  T  >  0  and  an  admissible  input  u  :  [0,  T]  — >  U 
such  that  the  solution  (g(t),  74(f))  of  (9-10)  with 
initial  conditions  (g( 0),tx(0))  =  (<71 , 0)  satisfies 
(g(T),p(T))  =  (g2, 0). 

Theorem  3.10  If  the  dynamics  of  a  mechanical 
system  given  by  (9  -10)  are  such  that 

(i)  the  system  is  equilibrium  controllable,  and 

(ii)  the  reduced  dynamics  (10)  are  controllable, 
then  the  system  is  controllable. 

Proof:  We  need  to  show  that  there  exists  a 

T  >  0  and  an  admissible  control  u  :  [0,  T]  — >  U 
such  that  given  any  (gi,  741)  and  ( 57,74/ )  the  so¬ 
lution  (5(f), /x(f))  satisfies  (5(0), /x(0))  =  (51,7x1) 
and  {g(T),  y,(T))  =  (5/,  5/).  Using  the  properties 
(i)  and  (ii)  we  construct  such  a  control. 

Assume  that  there  exists  a  state  (53,0)  and  an 
admissible  control  u' ,  such  that  u'  will  steer  the 
system  from  (53,0)  to  (57,5/)  in  finite  time. (The 
existence  of  such  a  (53,0)  and  u'  is  shown  later.) 
The  problem  is  now  reduced  to  finding  a  control 
to  steer  the  system  from  (5 1,7x1)  to  (53,0)  which 
is  done  as  follows. 

Let  g(t,  fo,5o,/x(f))  denote  the  the  solution  of  (9) 
at  t  >  to  for  a  particular  curve  71(f)  €  g*  and 
initial  condition  go.  Similarly  let  /x(f,  to,  7x0,  w(t)) 
denote  the  the  solution  of  (10)  at  t  >  to  for  a 
particular  input  u  and  initial  condition  710,  and  let 
£(f,  fo,  (go,go),u)  denote  the  solution  of  (9-10)  at 
t  >  to  for  a  particular  input  u  and  initial  condition 
(5o,/xo)- 

1.  Since  the  reduced  dynamics  are  controllable 
there  exists  a  T)  >  0  and  a  control  u\  such  that 
C(2"i,  0,  (51, 7x1),  xxi)  =  (52,0)  (for  some  52). 

2.  Since  the  dynamics  are  equilibrium  controllable 
there  exists  a  T2  >  T)  >  0  and  a  control  xx2  such 
that  C(T2,Ti,  (52,0),xx2)  =  (53,0). 

3.  Finally  applying  u'  we  have 
C(T3,  T2,  (53,  0),  u')  =  (5/,  xf). 

The  existence  of  (53,0)  and  u'  is  shown  as  fol¬ 
lows.  Find  XX3  and  T(  such  that  p(T3,0,0,u3)  = 
747.  Existence  of  such  a  control  follows  from 
the  reduced  space  controllability  of  (10).  Ap¬ 
ply  the  control  1x3  to  (9-10)  with  initial  condi¬ 
tion  /x(0)  =  0  and  arbitrary  5(0)  =  g3.  Then 
C(T3,0,  (03>°)>u3)  =  (54,  /x/)  where  54  need  not 


be  equal  to  5/.  Let  g{t ,  0,  g3,  /x(t))  denote  the  solu¬ 
tion  to  (9)  where  74(f)  =  /x(f,  0, 0, 1x3).  Let  R  £  G. 
Then  by  left  invariance  5  =  Rg(t,,0,  g3, 74(f))  is  a 
solution  to  (9-10).  Choose  R  such  that  g{T3)  = 
Rg(l 3>0,53,/x(f))  =  5/,  i.e  R  =  g^gf  and  hence 
g(t)  =  5415/5(f,  0,53,/x(f)).  Again  from  left  in¬ 
variance  it  implies  that  g(T(,  0,  g^1gjg3, 74(f))  = 
5/  or  equivalently  {gf’1gfg3,0),u3)  = 

Hence  choose  53  =  g^lgfg3,  u'  =  u3 
and  T3  =  T2  +  T3.  ■ 

Given  G-invariant  dynamics,  controllability  of  re¬ 
duced  space  can  be  verified  using  Theorem  3.1 
and  Theorem  3.2.  Equilibrium  controllability 
can  be  verified  using  results  in  (Lewis  and  Mur¬ 
ray,  1996;  Bullo  and  Lewis,  1996)  where  the  follow¬ 
ing  sufficient  conditions  for  equilibrium  controlla¬ 
bility  are  presented. 

Let  ad^  :  g  — ►  g;  5  >->•  [£,77]  denote  the  adjoint  map 
and  adjl  denote  its  dual.  Let 

g  =  gi  (ii) 

m 

I£  =  ad*I£  +  ^  f  u%  (12) 

i- 1 

define  G-invariant  dynamics  on  TG.3  Define  the 
symmetric  product  {■  :  ■)  :  g  x g  — >  g  :  £ ,  77 1— 7  (£  :  77) 
as 

(£  :  77)  =  — I_1(ad|l77  +  ad;i£)  (13) 

Let  B  =  {bi,  -  ■  ■  ,bm}  C  g  (a  left  invariant  dis¬ 
tribution  on  G)  denote  the  input  subspace.  In 
the  present  setting  bi  =  ID1/*.  Let  Lieg(B)  and 
Symg  (B)  denote  the  involutive  and  symmetric  clo¬ 
sure  of  B  in  g.  A  symmetric  product  is  bad  if  it 
contains  an  even  number  of  each  of  the  vectors  in 
B.  A  symmetric  bracket  is  good  if  it  is  not  bad. 

Theorem  3.11  (Lewis  and  Murray,  1996;  Bullo 
and  Lewis,  1996)  The  system  (11-12)  is  equi¬ 
librium  controllable  if  rank(Lieg(Symg)(B))  = 
dim(G)  and  every  bad  symmetric  product  can  be 
written  as  a  linear  combination  of  good  symmet¬ 
ric  products  of  lower  degree. 

We  now  apply  Theorem  3.10  to  the  autonomous 
underwater  vehicle  with  coincident  center  of  mass 
and  center  of  buoyancy.  Controllability  of  reduced 
dynamics  follows  from  Proposition  3.4.  Equilib¬ 
rium  controllability  of  the  above  dynamics  can 
now  be  verified  using  Theorem  3.11.  Details  re¬ 
garding  the  relevant  symmetric  bracket  calcula¬ 
tions  can  be  found  in  (Manikonda,  1997) 

Proposition  3.12  The  unreduced  dynamics  (5- 
8)  of  the  autonomous  under  water  vehicle  with  co¬ 
incident  center  of  mass  and  center  of  buoyancy, 
defined  on  T*SE( 3)  (or  equivalently  TSE(3))  are 
controllable  if  Ii  ^  J2. 

Remark:  In  the  case  of  the  unreduced  jet-puck 
dynamics  as  we  have  only  one  input,  every  non 

■’In  (Lewis  and  Murray,  1996;  Bullo  and  Lewis,  1996)  it 
is  assumed  that  the  dynamics  evolve  on  TG.  Setting  //  = 
1 7.  the  two  formulations  (9-10)  and  (11-12)  are  equivalent. 


trivial  second  order  symmetric  bracket  is  bad. 
Hence  sufficient  conditions  for  equilibrium  control¬ 
lability  are  not  satisfied  and  hence  we  cannot  con¬ 
clude  controllability  of  unreduced  dynamics. 

4  DISSIPATIVE  FEEDBACK 
CONTROL 

In  this  section  we  study  stabilization  of  fixed 
points  of  the  reduced  dynamics.  These  fixed 
points  give  rise  to  relative  equilibria,  i.e.  trajecto¬ 
ries  that  are  group  orbits  in  the  unreduced  phase 
space.  For  example,  steady  translations  and  ro¬ 
tations  correspond  to  relative  equilibria  for  the 
underwater  vehicle.  The  energy-Casimir  method 
serves  (cf.  (Bloch  et  al.,  1992;  Bloch  and  Mars- 
den,  1990))  as  a  good  tool  to  study  stability 
of  equilibria  corresponding  to  dynamics  of  Lie- 
Poisson  type.  Having  identified  unstable  equi¬ 
libria,  various  approaches  have  been  adopted  to 
stabilize  them.  In  (Bloch  et  al,  1992;  Bloch  and 
Marsden,  1990;  Leonard,  1996)  feedback  laws  have 
been  chosen  such  that  the  closed  loop  system  is 
still  Hamiltonian  with  respect  to  a  Poisson  struc¬ 
ture  defined  on  the  quotient  manifold.  The  ad¬ 
vantage  of  choosing  such  a  feedback  law  is  that 
the  closed  loop  system  again  lends  itself  to  sta¬ 
bility  analysis  using  the  energy-Casimir  method 
or  similar  techniques.  We  refer  to  these  controls 
as  Hamiltonian  feedback  controls.  In  this  section 
we  present  constructive  feedback  laws  to  stabilize 
relative  equilibria  of  Hamiltonian  systems  using 
dissipative  control  laws.  We  define  a  control  law 
to  be  dissipative  if  the  divergence  of  the  closed  loop 
system  is  less  than  zero.  The  approach  is  based  on 
the  observation  that,  under  certain  hypothesis  the 
fixed  points  of  the  Lie-Poison  reduced  dynamics 
can  be  shown  to  belong  to  an  immersed  equilib¬ 
rium  manifold.  The  existence  of  this  equilibrium 
manifold  and  controllability  is  used  to  construct 
stable  center  manifolds.  The  main  ideas  behind 
this  approach  are  described  below. 

Consider  the  Lie-Poisson  reduced  dynamics  on  j’ 
given  by 

m 

p  =  f(p)  +  X]  peg*.  (14) 

i 

Exploiting  the  symplectic  foliation  of  g*  by  coad- 
joint  orbits  we  make  the  following  observation  (see 
(Manikonda,  1997)  for  proof). 

Theorem  4.1  Let  pe  be  an  equilibrium  point  of 
(If)  such  that  there  exists  a  neighborhood  V  of 
pe  in  which  the  Poisson  tensor  A (p)  has  con¬ 
stant  rank.  Then  in  V  there  exists  an  im¬ 
mersed  submanifold  £  such  that  for  all  p  € 
£,  Xpj(p)  =  0.  Further  locally  there  exist  coor¬ 
dinates  (yi,  ■  ■  ■ ,  yr,  zi,  zn-r)  such  that  z  =  0  on 
£. 

We  call  £  the  equilibrium  submanifold.  Lets  as¬ 
sume  that  £  is  of  dimension  k.  Choose  coordinates 
(y,  z )  in  a  neighborhood  V  of  pe  such  that  z  =  0 
on  £.  In  these  coordinates  pe  =  (ye,  0)  and(14) 
can  be  written  as 

m  m 

y  =  A\z  +  J1{y,z)  +  '^2b\ui  +  ^Fy1{y,z)u1{lS) 

i= 1  i= 1 


Figure  1:  Stabilizing  dissipative  feedback  laws  for  the 
Hovercraft.  ge  =  (2,  0,  0),  Ai  =  A2  =  —0.1 


i  =  A%z  +  f2 (y,  z) +  Y^b'fui  + ^2  y2(y,z)u1  (16) 
4=1  4=1 

where  A\  =  df  z)  |(yo>0)  and  A\  = 

9 f  I (x/o >0)  *  We  refer  to  (16)  as  the  trans¬ 
verse  dynamics.  Now  if  the  linearized  transverse 
dynamics  are  controllable  it  is  easy  to  show  (cf. 
(Manikonda,  1997;  Zenkov  et  al,  1997))  that  one 
can  find  a  feedback  law,  such  that  z  =  0  is  a  stable 
center  manifold  (Carr,  1981)  or  equivalently  pe  is 
a  stable  (in  the  sense  of  Lyapunov)  equilibrium 
point  of  the  closed  loop  system. 

Theorem  4.2  Under  the  assumption  that  (If) 
has  an  equilibrium  submanifold  £,  there  exists  a 
class  of  state  feedback  laws  u\(p)  =  K\z  +  <j>\(z), 
with  4>\(0)  =  0,  such  that  {yo,0)  £  £,  jo  /  0 
is  a  stable  equilibrium  of  the  closed  loop  system  if 
the  linearized  transverse  dynamics  (16)  are  stabi- 
lizable.  Further  for  all  trajectories  ( y(t),z(t ))  of 
the  closed  closed  loop  system  sufficiently  close  to 
the  origin 

(y(t),z(t))  —>  (c,  0)  as  t  — >  00 

i.e  the  closed  loop  system  is  asymptotically  stable 
in  z  and  stable  in  y. 

Using  this  approach  we  find  a  class  of  linear  feed¬ 
back  laws  to  stabilize  unstable  relative  equilibria 
for  the  hovercraft  and  underwater  vehicle. 


Proposition  4.3  ;  The  class  of  feedback  laws, 
parameterized  by  Ai,A2  given  by 


U\l , A  2 


A1A2  _  ,  (Ai  +  A2)  \1\2PI 


Ai,  A2  >  0 
(17) 


stabilize  the  equilibrium  (0,P{’,0)  of  (3)  for  any 
P?  7^  0 


Remark:  (i)  If  Pf  <  0  then  the  divergence  of 
the  closed  loop  system  is  less  than  zero  for  any 
choice  of  Ai,A2  >  0,  making  the  closed  loop  sys¬ 
tem  dissipative,  (ii)  If  P°  >  0  then  Ai,A2  >  0 
can  be  chosen  such  that  the  closed  loop  system  is 
dissipative. 

Figure  1  shows  the  trajectories  of  the  closed  loop 
system  with  a  dissipative  feedback  law  for  vari¬ 
ous  initial  conditions  in  the  neighborhood  of  the 
equilibrium. 


We  now  construct  linear  feedback  laws 
to  stabilize  the  equilibrium  solution 
xe  =  (0, 0,  II3, 0,  0,  P3 ),  P3  7^  0  for  the  un¬ 
derwater  vehicle.  We  assume  that  ?n3  <  mi. 
Recall  that  this  is  an  unstable  relative  equilibria 
(Lamb,  1945).  To  compare  our  results  with 
Hamiltonian  feedback  laws  lets  assume  that  in 
(7-8)  Ux  =  (ui,«2,«3)  and  U2  =  (0,0,0).  4 

Proposition  4.4  There  exists  a  class  of  state 
feedback  laws  of  the  form  Ui  =  + 

<M'20><&(0)  =  0,  where  z  =  (zi,---z5)  = 

(Hi,  n2, n3,Pi,P2)  such  that  the  equilibrium  xe  = 
(0,  0, 0,  n3,  0,  P3),  P3  7^  0  is  a  locally  stable  equi¬ 
librium  of  the  closed  loop  system  (7-8). 


Figure  2:  (Left):Dissipative  feedback  law  for  the 
AUV.  (Right):  Stabilizing  Hamiltonian  Feedback 
Law 

In  Fig.  2  (left)  we  stabilize  the  unstable  rela¬ 
tive  equilibrium  (0, 0,  0, 0,  0, 1)  using  a  dissipative 
feedback  law.  (In  the  simulations  ?n3  <<  mi). 
Observe  that  the  states  n(t),Pi(t)  and  P2(t)  are 
asymptotically  stable.  (Compare  the  results  with 
Fig.  2  (right)  where  a  Hamiltonian  feedback  law 
has  been  chosen  to  stabilize  the  same  equilibrium). 
Since  the  divergence  of  the  closed  loop  system  is 
less  than  zero  one  might  conjecture  that  under 
assumptions  of  boundedness  of  solutions  and  ab¬ 
sence  of  limit  cycles  the  closed  loop  system  is  glob¬ 
ally  stable,  i.e.  globally,  trajectories  converge  to 
the  stable  manifold  (“attractor”).  Analytical  re¬ 
sults  for  the  examples  discussed  did  seem  to  indi¬ 
cate  this. 

5  CONCLUSIONS 

In  this  paper  we  presented  results  related  to  con¬ 
trollability  and  stabilization  of  a  class  of  nonlinear 
left-invariant  mechanical  systems  with  symmetry. 
Our  results  on  controllability  provide  a  manage¬ 
able  tool  to  check  for  controllability  of  a  wide 
class  of  mechanical  systems  including  hovercraft 
and  underwater  vehicles.  We  also  presented  an 
approach,  based  on  center  manifold  techniques,  to 
design  feedback  laws  to  stabilize  relative  equilib¬ 
ria. 

Future  directions  of  research  include  designing 
constructive  control  laws  to  steer  in  T*G,  stabi¬ 
lization  of  the  unreduced  dynamics  and  in  show¬ 
ing  global  stability  of  the  closed  loop  system  under 
the  dissipative  feedback  laws. 

4In  general,  any  set  of  control  vector  fields  may  be  cho¬ 
sen  as  long  as  hypotheses  of  Theorem  4.2  are  met. 
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